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Executive  Summary 

In  the  past,  linear  kinematics  models  have  been  used  for  development  and  analysis  of 
guidance  laws  for  missile/  target  engagements.  These  models  were  developed  in  fixed  axis 
system  under  the  assumption  that  the  engagement  trajectory  does  not  vary  significantly  from 
the  collision  course  geometry.  While  these  models  take  into  account  autopilot  lags  and  'soft' 
acceleration  limits,  the  guidance  commands  are  applied  in  fixed  axis,  and  ignore  the  fact  that 
the  missile/  target  attitude  may  change  significantly  during  engagement.  This  latter  fact  is 
particularly  relevant  in  cases  of  engagements  where  the  target  implements  evasive 
manoeuvres,  resulting  in  large  variations  of  the  engagement  trajectory  from  that  of  the 
collision  course.  A  linearised  model  is  convenient  for  deriving  guidance  laws  (in  analytical 
form),  however,  the  study  of  their  performance  characteristics  still  requires  a  non-linear  model 
that  incorporates  changes  in  body  attitudes  and  implements  guidance  commands  in  body  axis 
rather  than  the  fixed  axis.  In  this  report,  a  3-D  mathematical  model  for  multi-party 
engagement  kinematics  is  derived  suitable  for  developing,  implementing  and  testing  modern 
missile  guidance  systems.  The  model  developed  here  is  suitable  for  both  conventional  and 
more  advanced  optimal  intelligent  guidance,  particularly  those  based  on  the  'game  theory' 
guidance  techniques.  These  models  accommodate  changes  in  vehicle  body  attitude  and  other 
non-linear  effects,  such  as,  limits  on  lateral  acceleration  and  aerodynamic  forces.  The  model 
presented  in  this  report  will  be  found  suitable  for  computer  simulation  and  analysis  of  multi¬ 
party  engagements. 
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(xi,yi,Zi): 

(ui,Vi,Wi): 

laxi’ayi’azj): 

laxij’ayij’azij): 

(*i’ai’ai): 

kij’aij’aijJ: 


Tyi  ,Tzi  : 

®s..  : 

_sij 

®i  =  (Pi,Qi,Ri): 

=(Pi»qi»ri): 


Nomenclature 

number  of  interceptors  (pursuers)  and  targets  (evaders) 
respectively. 

are  x ,  y,  z-positions  respectively  of  vehicle  i  in  fixed  axis, 
are  x,  y,  z- velocities  respectively  of  vehicle  i  in  fixed  axis, 
are  x,  y,  z-accelerations  respectively  of  vehicle  i  in  fixed  axis, 
are  x,  y,  z-positions  respectively  of  vehicle  i  w.r.t  j  in  fixed  axis, 
are  x,  y,  z-velocities  respectively  of  vehicle  i  w.r.t  j  in  fixed  axis, 
are  x,  y,  z-accelerations  respectively  of  vehicle  i  w.r.t  j  in  fixed  axis. 

are  x  ,y,  z-position,  velocity  and  acceleration  vectors  of  vehicle  i  in 
fixed  axis. 

are  x,  y,  z  -  relative  position,  velocity  and  acceleration  vectors  of 

vehicle  i  w.r.t  j  in  fixed  axis. 

separation  range  of  vehicle  i  w.r.t  j  in  fixed  axis. 

closing  velocity  of  vehicle  i  w.r.t  j  in  fixed  axis. 

are  line-of-sight  angle  (LOS)  of  vehicle  i  w.r.t  j  in  Azimuth  and 
Elevation  planes  respectively. 

x,  y,  z-accelerations  respectively  achieved  by  vehicle  i  in  body  axis. 

x,  y,  z-accelerations  respectively  demanded  by  vehicle  i  in  body  axis. 

are  yaw,  pitch  and  roll  body  (Euler)  angles  respectively  of  the  ith 
vehicle  w.r.t  the  fixed  axis. 

is  the  transformation  matrix  from  body  axis  to  fixed  axis, 
is  the  velocity  of  vehicle  i. 

autopilot's  longitudinal  time-constant  for  vehicle  i. 

autopilot's  lateral  time-constant  for  vehicle  i. 

line  of  sight  (LOS)  rotation  vector  for  vehicles  i  and  j. 

body  rotation  vector  for  vehicles  i  as  seen  in  fixed  axis, 
body  rotation  vector  for  vehicles  i  as  seen  in  body  axis, 
demanded  body  rotation  vector  for  vehicles  i  as  seen  respectively  in 
fixed  and  in  body  axis. 
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1.  Introduction 


In  the  past  [1,  2]  linear  kinematics  models  have  been  used  for  development  and  analysis  of 
guidance  laws  for  missile/  target  engagements.  These  models  were  developed  in  fixed  axis 
under  the  assumption  that  the  engagement  trajectory  does  not  vary  significantly  from  the 
collision  course  geometry.  While  these  models  take  into  account  autopilot  lags  and 
acceleration  limits,  the  guidance  commands  are  applied  in  fixed  axis,  and  ignore  the  fact  that 
the  missile/ target  attitude  may  change  significantly  during  engagement.  This  latter  fact  is 
particularly  relevant  in  cases  of  engagements  where  the  target  implements  evasive 
manoeuvres,  resulting  in  large  variations  of  the  engagement  trajectory  from  that  of  the 
collision  course  [3].  Linearised  models  are  convenient  for  deriving  guidance  laws  (in 
analytical  form),  however,  the  study  of  their  performance  characteristics  still  requires  a  non¬ 
linear  model  that  incorporates  changes  in  body  attitudes  and  implements  guidance 
commands  in  body  axis  rather  than  the  fixed  axis. 

In  this  report  a  mathematical  model  for  multi-party  engagement  kinematics  is  derived 
suitable  for  developing,  implementing  and  testing  modern  missile  guidance  systems.  The 
model  developed  here  is  suitable  for  both  conventional  and  more  advanced  optimal 
intelligent  guidance,  particularly  those  based  on  the  'game  theory'  guidance  techniques.  The 
model  accommodates  changes  in  vehicle  body  attitude  and  other  non-linear  effects  such  as 
limits  on  lateral  acceleration  and  aerodynamic  forces.  Body  incidence  is  assumed  to  be  small 
and  is  neglected.  The  model  presented  in  this  report  will  be  found  suitable  for  computer 
simulation  and  analysis  of  multi-party  engagements.  Sections  2  of  this  report  considers,  in 
some  detail,  the  derivation  of  engagement  dynamics,  in  section  3,  derivations  of  some  of  the 
well  known  conventional  guidance  laws,  such  as,  the  proportional  navigation  (PN)  and  the 
augmented  PN  (APN)  are  given. 


2.  Development  of  3-D  Engagement  Kinematics  Model 


Figure  1-Vehicle  Engagement  Geometry 
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2.1  Translational  Kinematics  for  Multi-Vehicle  Engagement 

A  typical  2- vehicle  engagement  geometry  is  shown  in  Figure  1;  we  shall  utilise  this  to 
develop  the  translational  kinematics  differential  equations  that  relate  positions,  velocities 
and  accelerations  in  x,  y,  z-  planes  of  individual  vehicles  as  well  as  the  relative  positions, 
velocities  and  accelerations.  Accordingly,  we  define  the  following  variables: 

(xi,y;,Zi):  x  ,y,  z-positions  respectively  of  vehicle  i  in  fixed  axis. 

(uj,v;,Wj):x,  y,  z-velocities  respectively  of  vehicle  i  in  fixed  axis. 

(ax.  ,ay.  ,az.  J:  x,  y,  z-accelerations  respectively  of  vehicle  i  in  fixed  axis. 


The  above  variables  as  well  as  others  utilised  in  this  report  are  functions  of  time  t .  The 
engagement  kinematics  (i.e.  position,  velocity  and  acceleration)  involving  n  interceptors  (often 
referred  to  as  pursuers)  and  m  targets  (referred  to  as  the  evaders)  (i  =  1,2,..., n  +  m),  in  fixed 
axis  (e.g.  inertial  axis)  is  given  by  the  following  set  of  differential  equations: 

d 

- X:  =  Uj 

dt  1  1 

(2.1) 

d 

^i=Vi 

(2.2) 

d 

- Zj  =  Wj 

dt  1  1 

(2.3) 

d 

—  Uj  =  a„. 

dt  1  Xl 

(2.4) 

d 

—  Vj  =  av. 

dt  1  yi 

(2.5) 

d 

—  Wj  =  a7. 

dt  1  Zl 

(2.6) 

In  order  to  develop  relative  kinematics  equations  for  multiple  vehicles  i,  j  involved  in  the 

engagement,  (i :  i  =  1,2,..., n;  j  =  1,2,..., m;  j  ^  i),  we  shall  write  the  relative  states: 

x;j  =  x;  -  Xj  :  x-position  of  vehicle  i  w.r.t  j  in  fixed  axis. 

y  ij  =  y  i  —  j  j  :  y-position  of  vehicle  i  w.r.t  j  in  fixed  axis. 

zjj  =  z  j  —  Zj  :  z-position  of  vehicle  i  w.r.t  j  in  fixed  axis. 

u  jj  =  u;  -  u  j  :  x-velocity  of  vehicle  i  w.r.t  j  in  fixed  axis. 

vij  =  Vi  -  Vj  :  y-velocity  of  vehicle  i  w.r.t  j  in  fixed  axis. 

Wij  =  wj  -  wj  :  x-velocity  of  vehicle  i  w.r.t  j  in  fixed  axis. 
a„..  =av.  -a„.  :  x-acceleration  of  vehicle  i  w.r.t  i  in  fixed  axis. 

ay„  =  ay.  -  ay  .  :  y-acceleration  of  vehicle  i  w.r.t  j  in  fixed  axis. 

a7..  =  a7.  -  a,.  :  y-acceleration  of  vehicle  i  w.r.t  i  in  fixed  axis. 

zij  L\  J  ’ 
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2.1.1  Vector/Matrix  Representation 


It  will  be  convenient  for  model  development,  to  write  equations  (2.1)-(2.6),  in  vector  notation 
as  follows: 

d  (2-7) 


dt 


5i  =Si 


— ui  =  ai 

dt  -1  -1 


(2.8) 


Where; 

Xj  =  [\j  y j  Zj  ]T  :  is  the  position  vector  of  vehicle  i  in  fixed  axis. 

Uj  =  [u;  Vj  W;  ]T  i  is  the  velocity  vector  of  vehicle  i  in  fixed  axis. 

a;  =  [ax.  ay.  az.  J1  :  is  the  target  acceleration  vector  of  vehicle  i  in  fixed  axis. 


Corresponding  differential  equations  for  relative  kinematics  in  vector  notation,  is  given  by: 

T,^=a-»  <Z9> 


—  U--  =  a-  -a, 

dt  “1J  -1  -J 


(2.10) 


Where: 

-ij  =  [xij  y ij  zij]  T  •  position  vector  of  vehicle  i  w.r.t  j  in  fixed  axis. 

Ujj  =  [u;j  vjj  Wjj  ] T  :  position  vector  of  vehicle  i  w.r.t  j  in  fixed  axis. 

a::  =  |a v. .  av..  a,..  T  =  a;  -  a;  :  acceleration  vector  of  vehicle  i  w.r.t  i  in  fixed  axis. 

-•j  l  xij  yij  zij  j  -i  -j  > 


Note:  The  above  formulation  admits  consideration  of  engagement  where  one  particular 
vehicle  (interceptor)  is  fired  at  another  single  vehicle  (target).  In  other  words  we  consider  one- 
against-one  in  a  scenario  consisting  of  many  vehicles.  This  consideration  can  be  extended  to 
one-against-many  if,  for  example,  i  takes  on  a  single  value  and  j  is  allowed  to  take  on  a 
number  of  different  values. 


2.2  Constructing  Relative  Range,  Range  Rates,  Sightline  (LOS)  Angles 
and  Rates  -  (Rotational  Kinematics) 

In  this  section,  we  develop  rotational  kinematics  equations  involving  range  and  range  rates, 
and  sight-line  (LOS)  angle  and  rates;  measurements  of  these  variables  are  generally  obtained 
directly  from  on-board  seeker  (radar  or  IR)  or  derived  from  on  board  navigation  system  or  by 
other  indirect  means. 


2.2.1  Range  and  Range  Rates 

The  separation  range  Rjj  of  vehicles  i  w.r.t  j  may  be  written  as: 
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(2.11) 


Expressions  for  range  rate  Rjj  may  be  obtained  by  differentiating  the  above  equations,  and  is 


given  by: 

d_R  _r  XijUij  +  yijvij  f  zijwij  WS) 
dt  ^  U  Rij  Rij 


(2.12) 


Another  quantity  that  is  often  employed  in  the  study  of  vehicle  guidance  is  the  'closing 
velocity'  Vc„  which  is  given  by: 

Vc..  =-Rij  (2.13) 


As  noted  above,  the  range  and  range  rate  measurements  R;j ,  Rjj  are  either  directly  available  or 


indirectly  computed  from  other  available  information  (or  estimated  using  e.g.  a  Kalman  Filter- 
KF).  To  account  for  errors  in  these  values,  we  may  write: 


Rij  =  Rij  +  ARij  (2-14) 

Rij-Rij+ARjj  (2.15) 


Where: 

Ry  :  is  the  estimated /  measured  value  of  the  relative  range. 

Rjj  :  is  the  estimated/ measured  value  of  the  relative  range  rate. 

ARjj  :  is  the  measurement  error  in  relative  range. 

ARjj  :  is  the  measurement  error  in  relative  range  rate. 

2.2.2  Sightline  Rates 

The  sight  line  rotation  vector  <as..  (see  Figure  2)  is  related  to  the  relative  range  and 
velocity  x  jj ,  u jj  as  follows: 


ujj  =© 

— ‘J  — sii 


XXij 


(2.16) 


Where: 

©  =  [  co  j J.  co 2jj  ©3jj  J T  :  is  the  LOS  rotation  vector  of  vehicle  i  w.r.t  j  as  defined  in  (as 

seen  in)  fixed  axis. 

It  is  well  known  that  the  vector  triple  product  which  is  the  cross  product  of  a  vector  with 
the  result  of  another  cross  product,  is  related  to  the  dot  product  by  the  following  formula 
[4]:  axbxc  =  b  (a.c)-c  (a.b).  Taking  the  cross-product  of  both  sides  of  (2.16)  by  Xjjand 

applying  this  rule,  we  get 
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— ij  X  — ij  =  — ij  x  I  — s,j  ''  “1 


SijxNj)^Sij(xij.Xij)-Xij(xij.coSij 
Since  x^and  cos..  are  mutually  orthogonal,  therefore^  Xy.  cos„ 
xijxuij=®Sijtij.xij)=®Sij^ijTxij) 


(2.17) 


=  0 ;  hence: 


co,.. 

_sij 


XijXUy 


T  T 

Xij  X..  Xjj  Xjj 


0 

w 


IJ 


vij 


W ; 


“"ij 


T 


V  ijWij  -  z i j v i j  ^ 
(zijllij-XijWij 

(xijVij  -yijuij> 


-  V; 


U: 


Xss 

!J 

Nij 

1 

N 

1 _ 

(2.18) 


Figure  2.  Line  of  Sight  Rotation 

If  sightline  rate  values  are  required  in  body  frame  then  equation  (2.18)  has  to  be  transformed 
to  body  axis  to  obtain  sightline  rates  in  body  axis.  The  measurement  6os„  obtained  from  the 

seeker  used  to  construct  the  guidance  commands  is  given  by: 

cb  =®  +  Aco  (2.19) 

— sij  -sij  -sij 


Where: 

A©,..  :  seeker  LOS  rate  measurement  error. 

-sij 

The  above  relationships  (2.11)-(2.19)  will  also  be  referred  to  as  the  seeker  model. 
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2.3  Vehicle  Navigation  Model 

The  vehicle  navigation  part  of  the  model  is  concerned  with  developing  equations  that  allow 
the  angular  rotation,  of  the  vehicle  body,  to  be  generated  and  subsequently  computing  the 
elements  of  the  transformation  (direction  cosine)  matrix.  We  shall  utilise  the  quaternion 
algebra  [5]  to  achieve  this. 


Figure  3.  Axis  System  Rotation  Convention 


Let  us  define  the  following: 

(a ,ab  ,ab  j:  x,  y,  z-acceleration  achieved  by  vehicle  i  in  its  body  axis. 

The  transformation  matrix  from  fixed  to  body  axis  j  ,  for  vehicle  i  is  given  by  (see 
Figure  3): 


ab  " 
xi 

(c0i  CV|/i) 

(c0i  SV|/j) 

(-S0i) 

a 

xi 

ab 

yt 

ab 

L  ziJ 

— 

(s^j  S0 j  CV|/j  —  C(j)|  s\|/j) 
(c<|) j  S0J  CVPi  +  s(j)|  S\|/j  ) 

(s(j>i  S0;  SV|/j  +  C(|>i  CV|/j  ) 
(c4*j  S0j  s\|/j  -  sc));  CV|/j) 

C0i) 

(c<t>i  C0i) 

1 

K  N 

_ 1 

Abbreviations  s  and  c  are  used  for  sin  and  cos  of  angles  respectively. 
This  equation  may  also  be  written  as: 
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(2.20) 


In  vector/ matrix  notation  this  equation  along  with  its  companion  (inverse)  transformation, 
may  be  written  as: 


•li  =  [' 

*1 

(2.21) 

-i  =  ['l 

:].  *r 

(2.22) 

Where: 


(\|/j , 0| ,  <(>i):  are  (Euler)  angles  of  the  ith  vehicle  w.r.t  the  fixed  axis. 

1  I  1  1_  L  II 

a”  =  |ax  a“  a”  J  :  is  acceleration  vector  of  vehicle  i  in  its  body  axis. 
[4  =  [if5  ]  j  =  [rfb  ]  j  :  is  the  transformation  matrix  from  body  to  fixed 


axis. 


2.3.1  Application  of  Quaternion  to  Navigation 

A  fuller  exposition  on  quaternion  algebra  is  given  in  [5];  in  this  section  the  main  results  are 
utilised  for  the  navigation  model  for  constructing  the  transformation  matrix.  We  define  the 
following  quantities,  referred  to  as  the  quaternions,  for  vehicle  i  as  follows: 


0i  Vi  .  <h  .  0;  .  Vi 

q  i  =  cos  —  cos— cos  -^  +  8111  —  sin— sm  — 

1  2  2  2  2  2  2 

(2.23) 

.  <l>i  ®i  Vi  <l>i  .  6i  .  Vi 

q?-  =  sin — cos  —  cos - cos — sin  —  sin  — 

1  2  2  2  2  2  2 

(2.24) 

<|>;  .  ©i  Vi  <l>i  6i  .  Vi 

qi.  =cos— sin— cos — L  +  sin— cos  — sin— L 

1  2  2  2  2  2  2 

(2.25) 

<i>i  6i  .  Vi  •  ^i  •  0i  Vi 

q4.  =  cos  —  cos — sin - sin  —  sm — cos  — 

1  2  2  2  2  2  2 

(2.26) 

It  can  be  shown  that  the  transformation  matrix 


.  for  the  ith  vehicle  may  be  written  as: 


Hi 

*12} 

*13; 

21{ 

*22; 

*23; 

31i 

t32  t33. 

(2.27) 


Where:  the  elements  of 


are  functions  of  the  quaternions  are  given  by  the 


following  relations: 

(  2  2  2  2  1 
tlli  —  \flli  +<l2i  _<l3;  _(U;  / 

*12;  -2((l2itl3i  +Qli(l4i) 
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*13;  =  2(q2.q4.  -qiiQSi  j 

(2.30) 

tnj  =  2(q2i93i 

(2.31) 

*22;  =  (qi;2  ^2^  +q3;2  _  <14;  2  ) 

(2.32) 

*23;  =  2(q3;q4;  +  qi;  q2;  j 

(2.33) 

*31;  =  2(q2;q4;  +qi;q3;  j 

(2.34) 

*32;  =2^3^;  -91^2;) 

(2.35) 

,  [  2  2  2  2l 

*33;  -K  _q2;  ^3;  +  q4;  j 

(2.36) 

The  time-evolution  of  quaternion  is  given  by  the  following  differential  equation: 


qq 

0 

-Pi 

-qi 

-J*i 

qq 

d 

q2; 

1 

Pi 

0 

ri 

-qi 

q2i 

dt 

q3; 

~2 

qi 

0 

Pi 

q3i 

q4;_ 

_ri 

qi 

-Pi 

0 

q4i 

(2.37) 


In  vector  notation  equation  (2.37)  may  be  written  as: 


d 

— q. 

=  [n? 

k 

(2.38) 

dt  -1 

Where: 

0 

-Pi 

-qi 

-n 

N'l4 

Pi 

0 

n 

-qi 

qi 

"ri 

0 

Pi 

_ri 

qi 

-Pi 

0 

%  =  k 

q2i 

q3i 

q4;. 

|T:is 

the  quaternion  vector  for  vehicle  i. 

=ti 

qi 

ri]  T  : 

:  is  the  rotation  vector  of  vehicle  i  w.r.t  to  the  fixed  axis  as  seen  in  the 

body  axis  (also  referred  to  as  body  rate  vector). 


The  Euler  angles,  in  terms  of  the  elements  of  the  transformation  matrix,  may  be  written  as: 


4»j  =  tan 


-1  *23i 


l33 


i  J 


Gi  =sin  '(-ti3i) 


v|/j  =  tan 


-1  l12i 


Clli 


(2.39) 

(2.40) 

(2.41) 


0;  *90° 


2.3.2  Body  Incidence  Angles  and  Flight  Path  Angles 

he  vehicle  (absolute)  velocity  in  fixed  axis  (which  is  the  same  as  the  absolute  velocity  in 
body  axis)  is  given  by: 
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/  \ 1 

(  \  1 

(  T 

\ 

/  2  ,  2  ,  2  I 

T  W 

b 1  b 

1  U;  +  V;  +  W;  I2  =  1 

IS 

IS 

1. 

II 

u-  u- 
—1  —1 

J 

2  =V.b 


(2.42) 


Where: 

ai-k  'i  :  is  the  velocity  vector  of  vehicle  i  in  body  axis. 

Vib  =Vj  :  is  the  vehicle  velocity  in  body  axis. 

Given  that  the  body  incidence  angles  in  pitch  and  yaw  are  (a; ,  Pj ) ,  the  flight  path  angles  in 
pitch  and  yaw  (=angle  that  the  velocity  vector  makes  with  the  fixed  axis)  are  respectively 
(Gi-cti)  and  (vj/j  -pi). 


Where: 


_l  w • 

04  =  tan  — :  is  the  body  pitch  incidence  angle. 


u 


—  1  v* 

Pi  =  tan  — L-  :  is  the  body  azimuth  incidence  (side-slip  angle). 


Assuming  that  (vb  ,w{*  j«  uj3  thus  lends  justification  to  the  assumption  that  (a j , P  j  )are 
small.  Furthermore  differentiating  the  expressions  for  (cx,j,Pj)  and  simplifying  gives  us: 


a  -,  - 


wjuf  -nhwl3 


V+wb 


Pi  = 


2  ^ 
) 


nf  +vf' 


(2.43) 


(2.44) 


For(vj>,w|>,u{>]«  u|> ,  we  get  (a  j ,  p  j )  ~  0.  In  this  report  we  shall  assume  that  the  incidence 
angles  (04 ,  P| )  and  the  rates  (a  j ,  p  j )  are  small  and  hence  can  be  ignored;  and  the  vehicle  body 
may  be  assumed  to  be  aligned  to  the  velocity  vector. 

2.3.3  Computing  Body  Rates  (p^q^rj) 

We  now  consider  equations  (A1.1)-(A1.3),  from  Appendix-1  for  the  ith  vehicle,  which 
we  write  as: 


b 

■  b  .  b 

b 

xi 

=  Uj  +qw; 

-rv} 

b 

■  b  .  b 

b 

yi 

-V}  +ruj 

-PW} 

b 

•  b  .  b 

b 

zi 

=  Wj  +pVi 

-qui 

(2.45) 

(2.46) 

(2.47) 
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In  matrix  notation  equations  (2.45)-(2.4 7)  may  be  written  as: 


ab  " 
xi 

ub 

1 

0 

“ri 

Hi 

ub 

1 

ab 

yi 

= 

vb 

1 

+ 

ri 

0 

“Pi 

vb 

1 

ab 

yi  J 

wj5 

-Hi 

Pi 

0 

wj5 

This  equation  is  of  the  form: 


■  b 


4i  =  Hi  +  x  Hi 


(2.48) 


(2.49) 


Note:  As  pointed  out  earlier  it  is  assumed  that  the  missile  body  is  aligned  with  the  velocity 
vector  (section  2.3.2);  moreover  if  aj1  is  regarded  as  the  lateral  acceleration  acting  on  the 


velocity  vector  then  aj,,ra|),uj) can  be  assumed  to  be  mutually  orthogonal,  i.e.: 


Taking  the  cross  product  of  equation  (2.49)  with  uj5 ;  applying  the  triple  cross-product  rule, 
and  noting  the  fact  that  (raj5  .uj5  )=  0 ,  we  get: 


4N 

=  uj5  X  U j5  +  u j5  : 

x  Hi*  Hj5  x  uj5 

-»  b 

b 

b 

b 

Hi 

Hi 

Hi 

Hi 

>wj’,uj5) 

|  and 

(4. 

wf) 

b  ■  b 

\{  b 

•  b 

b 

Hi  xuj 

_llvi 

Wj  - 

-  Wj  i 

-i 


uj5  xuj  +  (0 


(2.50) 

(2.51) 


ub.ub 
—1  —1 


ubxab  ffvpa*5  -  wj5ab  )  (wj5ab  -uj’a15  )  (u^ab  -v^15  t 

,  b  Hi  x  LV  1  zj  1  yi  /  V  1  xj  i  zj  /  V  i  yi  1  x,  /J 

®i  =  .  = - urc - 


Hi 


Hi 


Hi 


Hi 


(2.52) 


(2.53) 


2.4  Vehicle  Autopilot  Dynamics 

Assuming  a  first  order  lag  for  the  autopilot,  we  may  write  for  vehicle  i : 


—  ab 

=  “Txi 

ab 

+  *xi 

ab 

dt  xi 

xi 

x*d 

— ab 

=  — Tv. 

ab 

+  Tv. 

ab 

dt  yi 

yi 

yi 

yi 

yid 

— ab 

-  -Tzi 

ab 

^Z| 

ab 

dt  zi 

zi 

Zid 

(2.54) 

(2.55) 

(2.56) 
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In  vector/ matrix  notation  equations  (2.54)-(2.56)  may  be  written  as: 

A,b=[_Al],f+[A|],b 


(2.57) 


Where: 

xx.  :  Vehicle  i  autopilot's  longitudinal  time-constant. 

Ty.  :  Vehicle  i  autopilot's  (lateral)  yaw-plane  time-constant. 
xz.  :  Vehicle  i  autopilot's  (lateral)  pitch-plane  time-constant. 

0  0 


[A.]  = 


V*i 

0  Tyi 

0  0  X 


0 


x*d 


a 


a 


yid 

b 

Eid 


x-acceleration  demanded  by  vehicle  i  in  its  body  axis, 
y-acceleration  demanded  by  vehicle  i  in  its  body  axis. 
:  z-acceleration  demanded  by  vehicle  i  in  its  body  axis. 


*1- 


*d 


ab  ab 
yid  z 


-|T 


id 


:  is  the  demanded  missile  acceleration  (command  input)  vector  in 


body  axis. 

2.5  Aerodynamic  Considerations 

Detailed  consideration  of  the  effects  of  the  aerodynamic  forces  is  contained  in  Appendix-1. 
Generally,  the  longitudinal  acceleration  ab  =  — - -  of  a  missile  is  not  varied  in  response 

Xid  nij 

to  the  guidance  commands  and  may  be  assumed  to  be  zero.  However,  the  nominal  values. 


which  define  the  steady  state  flight:  ab 


h-p) 


m 


gsinG,  ab  = —  +  g cos 0 sin <|)  and 


m 


.  Z  -  - 

a  = - h  g  cos  0  cos  <|)  may  change  due  to  changes  in  flight  conditions  and  need  to  be  included 


m 


in  the  simulation  model;  this  is  shown  in  the  block  diagram  Figure  A.l.  The  variations  in 

gY  ^  ~ 

lateral  accelerations  8  ab  =  —  =  SY ,  8  ab  =  —  =  8Z ,  on  the  other  hand  provide  the  necessary 

m  m 

control  effort  required  for  guidance;  the  limits  on  these  may  be  implemented  as  shown  in 


Appendix-1,  that  is: 


yid 


<  p  a 


ymax 


and 


abz- 
Zld 


<pa2 
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3.  Conventional  Guidance  Laws 


3.1  Proportional  Navigation  (PN)  Guidance 

There  are  at  least  three  versions  of  PN  guidance  laws  that  the  author  is  aware  of;  in  this 
section  we  consider  two  of  these,  which  are  (for  interceptor  i  -the  pursuer  against  a  target  j 
-  the  evader): 


3.1.1  Version  1  (PN-1): 

This  implementation  is  based  on  the  principle  that  the  demanded  body  rate  of  the  attacker 
i  is  proportional  to  LOS  rate  to  the  target  j(see  Figure  1);  that  is: 

“id=[N]i“Sij  (3-1) 


Where: 

— 'd  =K  Qid  Ridl  :  is  the  demanded  body  rotation  vector  of  vehicle  i  in  the  fixed  axis. 

[N].  =diag(N1.  N2.  N3.)  :are  navigation  constants  attached  to  respective  demand 

channels.  If  the  longitudinal  acceleration  is  not  possible  (as  is  the  case  in  most  missiles)  then 
Nx.  =0. 


The  acceleration  demanded  of  vehicle  i  is  given  by: 

5iri  =coiH  x  Uj  =  [n]  i  ©  xuj 


(3.2) 


Since  the  guidance  commands  are  applied  in  body  axis,  we  need  to  transform  equation  (3.2)  to 
body  axis,  thus: 


Assuming  that  the  longitudinal  acceleration  in  response  to  the  guidance  commands  is  zero, 
we  get: 


8Tj  -  8Dj 
mi 


=  0 


(3.4) 


3.1.2  Version  2  (PN-2): 

This  implementation  is  based  on  the  principle  that  the  demanded  lateral  acceleration  of  the 
attacker  i  is  proportional  to  the  acceleration  normal  to  the  LOS  acceleration  to  target  j,  caused 
by  the  LOS  rotation.  Now,  the  LOS  acceleration  is  given  by: 

%•  =®s..  xujj  (3.5) 

*id  =  [N]i%  =[N]i®Sij  x«ij 
Transforming  to  body  axis,  gives  us: 
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(3.6) 


Once  again,  assuming  that  the  longitudinal  acceleration  in  response  to  the  guidance 
commands  is  zero,  we  get: 


8T}  -8Dj 

mi 


-0 


(3.7) 


Where: 

a„ ..  : is  the  normal  LOS  acceleration. 

“nji 


3.2  Augmented  Proportional  Navigation  (APN)  Guidance 


Finally,  a  variation  of  the  PN  guidance  law  is  the  APN  that  includes  the  influence  of  the 
target  acceleration,  can  be  implemented  as  follows: 


PNG  N,co 


+ 


kit"]*) 


(3.8) 


Where: 

[n  ] :  is  the  (target)  acceleration  navigation  constant. 

(PNG): is  the  proportional  navigation  guidance  law  given  in  (3.1)-(3.7) 

4.  Overall  State  Space  Model 


The  overall  non-linear  state  space  model  (e.g.  for  APN  guidance)  that  can  be  used  for 
sensitivity  studies  and  for  non-linear  or  Monte-Carlo  analysis  is  given  below: 

d  (4-1) 


—  xa 

dt  J 


CO...  = 

— 


5j 


T 

5iJ 


(4.2) 

(4.3) 


PNG  N,co 


+ 


klM 


-j 


^.f=[-A1].r+[Al].i 


id 


u?xa? 


(4.4) 

(4.5) 

(4.6) 

(4.7) 


The  overall  state  space  model  that  can  be  implemented  on  the  computer  is  given  in  Table  A.l, 
and  the  block-diagram  is  shown  in  Figure  A.l. 
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5.  Conclusions 


In  this  report  mathematical  model  is  derived  for  multi-vehicle  guidance,  navigation  and 
control  suitable  for  developing,  implementing  and  testing  modern  missile  guidance  systems. 
The  model  allows  for  incorporating  changes  in  body  attitude  in  addition  to  autopilot  lags, 
vehicle  acceleration  limits  and  aerodynamic  effects.  This  model  will  be  found  suitable  for 
studying  the  performance  of  both  the  conventional  and  the  modern  guidance  such  as  those 
that  arise  of  game  theory  and  intelligent  control  theory.  The  following  are  considered  to  be  the 
main  contribution  of  this  report: 

•  A  3-DOF  multi-vehicle  engagement  model  is  derived  for  the  purposes  of  developing, 
testing,  and  carrying  out  guidance  performance  studies. 


•  The  model  incorporates  non-linear  effects  including  large  changes  in  vehicle  body 
attitude,  autopilot  lags,  acceleration  limits  and  aerodynamic  effects, 

•  The  model  can  easily  be  adapted  for  multi-run  non-linear  analysis  of  guidance 
performance  and  for  undertaking  Monte-Carlo  analysis. 
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Appendix  A 


Table  A.l:  State  Space  Dynamics  Model  for  Navigation,  Seeker,  Guidance  and  Autopilot. 
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Navigation 


Figure  A.l:  Intelligent  Integrated  Navigation,  Guidance  &  Control  Test  Bed 


18 


UNCLASSIFIED 


UNCLASSIFIED 


DSTO-TR-2805 


Appendix  B 

B.l  Aerodynamic  Forces  and  Equations  of  Motion 

For  a  symmetrical  body  (lzx  =  0;  Iy  =  Iz  J,  the  equations  of  motion  for  an  aerodynamic  vehicle 
are  given  by  (see  Figure  B.l)  [4]: 


ub  +  qwb  -rvb  =  — -gsinG 
m 

(A-l.l) 

vb  +  rub  -pwb  =  —  +  gcos0sin<|) 
m 

(A-1.2) 

wb  +pvb  —  qub  =  —  +  gcos0cos<|) 
m 

(A-1.3) 

L 

p  +  qr  - - —  =  — 

Ix  Ix 

(A-1.4) 

(lx-Iz)  M 
q  +  rp  — - —  =  — 

1  I 

y  y 

(A-1.5) 

lIy-IxJ  N 
r  +  pq  — - =  — 

I  I 

(A-1.6) 

Where: 

(ub,vb,wb  j: are  the  vehicle  velocities  defined  in  body  axis. 

(p,q,r) :  are  the  body  rotation  rates  w.r.t  the  fixed  axis  defined  in  the  body  axis. 

(x,  Y,z) :  are  the  aerodynamic  forces  acting  on  the  vehicle  body  defined  in  the  body  axis. 
(l,  M,  N ) :  are  the  aerodynamic  moments  acting  on  the  vehicle  body  defined  in  the  body  axis. 
(lx,Iy  ,IZ  j:  are  the  vehicle  body  inertias, 
m :  is  the  vehicle  mass. 

(v|/,0,(j>) :  are  respectively  the  body  (Euler)  angles  w.r.t  the  fixed  axis. 

For  a  non-rolling  vehicle  p  =  p  =  <j>  =  0 ;  this  assumption  enables  us  to  decouple  the  yaw  and 
pitch  kinematics.  Equations  (A-1.1)-(A1.6)  give  us: 


iib  +  qwb  -  rvb  =  —  -  g  sin  0 

(A-1.7) 

m 

vb  +  rub  =  — 

(A-1.8) 

m 

h  u  Z 

w  -qu  = - h g cos 0 

(A-1.9) 

m 

L  =  0 

(A-1.10) 

M 

q=7; 

(A-l.ll) 

y 

N 

r  =  — 

I. 

(A-1.12) 
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The  accelerations  about  the  vehicle  body  CG  is  given  by: 


=  iib  +qwb  - rvb  =  —  -gsin0 

(A-1.13) 

m 

=  vb  +  rub  =  — 

(A-1.14) 

m 

b  b  Z 

=  w  —  qu  = - 1-  g  cos  0 

m 

(A-1.15) 

Where:  (a*  ,ab  ,ab  ):  are  the  body  accelerations  w.r.t  the  fixed  axis  defined  in  the  body  axis. 


If  we  consider  perturbation  about  the  nominal,  we  get: 

,b  ,  ,,b_(x  +  8x) 

m 


ax°+8a"  = 


-  g  (sin  0  +  cos  0  80) 


5yb+6a‘=M 

111 


a  £  +  8  ab  =  +  +  g  (cos  0  -  sin  0  80) 

m 

B.2  2-D  Yaw-Plane  Kinematics  Equations: 

For  2-D  yaw-plane  kinematics  only  0  =  0;  80  =  0  (i.e.  zero  pitch  motion),  therefore,  the  X 
and  Y-plane  steady  state  equations  (in  body  axis)  may  be  written  as: 


Hy  =  —  =  Y 

J  m 


m  m 


iJ=W%BL(T-6) 
=  Y; 


(A-1.16) 

(A-1.17) 

Also,  the  total  thrust  is  defined  as: 


Where  we  define: 

m  mm 

T  =  T  +  8T ,  and  the  total  drag  is  defined  as:  D  =  D  +  8D . 

For  'nominal  flight'  condition  in  the  yaw-plane  Y  =  0 ;  and  the  perturbation  equation  is  given 
by: 


c*  b 

_  5Y 

8ab 

m 

„  h 

_  5X 

8a  x 

m 

Where  : 

(8T  -  8d) 


(A-1.18) 

(A-1.19) 


Say  : represents  the  body  axis  guidance  commands  (lateral  acceleration)  applied  by  the 
vehicle. 
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8 ax  :  represents  the  body  axis  guidance  commands  (longitudinal  acceleration)  applied  by  the 
vehicle.  However,  during  guidance  manoeuvre  (sT,  8d)  are  not  directly  controlled.  Hence  we 
may  assume  8ax  to  be  zero. 


B.3  2-D  Pitch-Plane  Kinematics  Equations: 


Unlike  the  previous  case,  for  2-D  pitch-plane  kinematics  0*0,  and  for  steady  state 
conditions,  we  get: 


z  _  ~  _ 

a  ”  = - t-  g  cos  0  =  Z  +  g  cos  0 

m 


ax  =  —  -  g  sin  0  =  ^ — —  -  g  sin  0  =  (t  -  d)-  g  sin  0 
m  m 


(t-p) 


(A-1.20) 

(A-1.21) 


The  X ,  Z  (pitch)-plane  perturbation  kinematics  (in  body  axis)  is  given  by: 


8a!?  =  — =  8Z 


m 


8a 


b  (8T-8D) 


m 


(8T  -  8d) 


(A-1.22) 

(A-1.23) 


Where 

8aj?  :  represents  the  body  axis  guidance  commands  (lateral  acceleration)  applied  by  the 
vehicle. 

As  in  the  case  of  the  yaw-plane,  during  guidance  (8T,  8d)  are  not  directly  controlled,  hence 
we  may  assume  8a x to  be  zero.  The  reader  will  recognize,  that  in  the  main  text  of  this  report: 

(A-1.24) 


Mi 


=  8ax,aD  =  8 a .  a D  =  8a 


yd 


y  “zd. 


B.4  Calculating  the  Aerodynamic  Forces 


For  the  purposes  of  the  simulation  under  consideration  we  may  assume  that  the  vehicle 
thrust  profile  T(t) ,  say  as  a  function  of  time,  is  given;  then  the  drag  force  D ,  which  depends  on 
the  vehicle  aerodynamic  configuration,  is  given  by: 


D  = 

Y  = 

Z  = 


~PV2sl  CD(a,p) 


ipV2s]cL(p)=0 


-pV2S  CL(a)=  -gcos0 


(A1.25) 

(A1.26) 

(A1.27) 


Where:  the  term  in  the  bracket  is  the  dynamic  pressure;  p  being  the  air  density,  S  is  the  body 
characteristic  surface  area  and  V  is  the  steady-state  velocity.  Cj)  is  the  drag  coefficient 
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and  CL  is  the  lift  coefficient,  (a,  p)  represent  respectively  the  pitch-  and  the  yaw-plane 
nominal  (steady-state)  incidence  angles.  Contribution  to  thrust  and  drag  due  to 
control  deflections  are  small  and  ignored.  Also: 


5y  =  ffpv2s]  Cl  (SP)=  0 


SZ: 


—  pV 2S  CL(8a)  =  -gsin0  80 


(A1.28) 

(A1.29) 


(8a,8p)  represent  respectively  the  variation  in  pitch-  and  the  yaw-plane  incidence 
angles  as  a  result  of  control  demands;  these  are  assumed  to  be  small.  Note  that  for  a 
given  (8a,8p),  8Y,8ZocV2,  the  maximum/ minimum  acceleration  capability  of  a 

vehicle  is  rated  at  the  nominal  velocity  V ,  then  the  maximum/  minimum  acceleration 
at  any  other  velocity  V  is  given  by: 


<  ^  a 


b 

ymax 


max 


;Where:  g  = 


2 


B.5  Body  Incidence 


The  body  incidence  angles  (a, p)  are  given  by  (vb ,  wb  «  ub ) : 

*  ^ ;  Vb  =  Vi  =  (  =  J»b2  +  vb2  +wb2  j ;  these  angles 
represent  the  angle  that  the  body  makes  w.r.t  'flight  path'  or  with  the  direction  of  the 


a  =  tan 


-l 


w 


W  _1 

>  — ;  p  =  tan 


D 
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total  velocity  vector  V .  In  this  report  we  shall  assume  that  these  angles  are  small  and 
may  be  ignored;  in  which  case  the  body  can  be  assumed  to  be  aligned  with  the 
velocity  vector. 
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Appendix  C  3-D  Collision  Course  Engagement 
Geometry  &  Computing  Missile  Collision  Course 

Heading 


M 


Figure  C.l:  Three-DOF  Collision  Course  Engagement  Geometry. 
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C.l  Computing  3-DOF  Collision  Course  Missile  Heading  Angles: 

C.1.1  Computing  (pXM ),  Given  (vx ,  0X ,  \j/x ,  0XM ,  \|/XM )  : 


The  unit  vector  along  the  target  body  ev T  and  the  unit  LOS  vector  esXM  may  be  written  as: 
evx  =  [cos 0X  cosy x  cos0xsinv|/x  sin0x]  (A2.1) 

esXM  -  [cos0TM  cos  0XM  sin  v|/XM  sin0XM]  (A2.2) 


It  follows  from  equations  (A2.1),  (A2.2)  that: 

^evx,  esXM  )  =  cosPXM  =  cos0x  cosv)/x  cos0XM  cosv|/XM 

+  cos  0T  sin  \j/T  cos  0XM  sin  v|/XM  +  sin  0X  sin  0XM 


(A2.3) 


Equation  (A2.3),  gives  us: 

_1  [cOS0x  COS\|/x  COS0XM  COSV)/XM 

I  +  cos  0X  sin  \j/T  cos  0XM  sin  \|/XM  +  sin  0X  sin  0XM 


Ptm 


cos 


(A2.4) 


Where: 

Ptm  ;is  the  angle  between  the  target  velocity  vector  and  the  target-to-missile  LOS  vector 
measured  in  (vx  xRXM  xVM  -  plane). 

Vx  :  is  the  target  velocity. 

VM  :  is  the  target  velocity. 

(0X ,  \j/x  ) :  are  respectively  the  body  pitch  and  yaw  body  angles  (Euler  angles)  w.r.t  the  fixed 
axis. 

(0XM ,  v|/Xm  ) :  are  respectively  the  target-to-missile  LOS  elevation  and  azimuth  w.r.t  the  fixed 
axis. 

C.l. 2  Computing  (pccMT  J,  Given  (vM  ,Ptm  )  : 

Consideration  of  collision  course  engagement  in  (vM  xVTx  Rmt  _  plane)  gives  us: 
VMsinpccMT  =  VTsinpXM  (A2.5) 

Equation  (A2.5)  gives  us: 

Pccmt  =sin“1|^-sinP™|  (A2-6) 

Where: 

PccMT  :  is  the  angle  between  the  missile  collision  course  velocity  vector  and  the  target-to- 
missile  LOS  vector  measured  in  (vx  x  RXm  x  Vm  -  plane) . 

C.l. 3  Computing  the  Closing  Velocity  (vCCCmt  )  and  Time-to-go  (Tg0)  : 
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We  shall  define: 

VCccMT  =VMcoSpccMT  -VTCOSpTM 
Also,  the  target/ missile  range-to-go  (Rxm  )  is  defined  as: 


(A2.7) 


RMT  -  [  (XM  -  Xx  )  2+  (ym  -  Yx  )  2  +  (zM  -  Zx  )  2  ]  2 

(A2.8) 

Then: 

rmt 

g0  VCcc 

(A2.9) 

Where: 

VCccMT  :  is  the  collision  course  relative  (closing)  velocity  of  the  missile 
that  the  collision  course  velocity  is  along  the  range  vector  RMT  . 

Tg0  :is  time-to-go  (to  intercept). 

w.r.t.  the  target.  Note 

2.1.4.  Computing  (0Mcc ,  Vmcc  J  = 

Now  the  components  of  the  relative  position  vector  of  the  missile  w.r.t  may  be  written  as : 
XM  -Xx  =  (vCccMX  cos0XM  cosv|/XM).Tgo 

=  (VM  COS0CCJVJ  COS  V|/  CCjyj  -  Vx  COS0X  COSV|/X  ).Tg0 

Ym  -  Yx  -  (vCccMX  COS0XM  sin\|/XM  ).Tg0 

=  (vM  cos0ccM  sin\j/ccM  -  Vx  cos0x  sin\j/x).Tg0 

(A2.ll) 

ZM  _ZT  =  (yCCCmt  sin 0XM  j.Tg0 

=  (vM  sin0ccM  -  Vx  sin0x).Tgo 

(A2.12) 

Where: 

v|/jvjcc  :^s  the  mLsile  collision  course  azimuth  heading,  measured  w.r.t  the  fixed  axis. 
0]yjcc  :  is  the  missile  collision  course  elevation  heading,  measured  w.r.t  the  fixed  axis. 


Equations  (A2.10),  (A2.ll)  and  (A2.12)  give  us: 
COS  0  CCjvjx  cos  V  CCMT 

/vcccMX 


'M 


COS0JM  COSV|/X]y|  H - — COS0T  COSVj/j 

VM 


(A2.13) 


cos0ccMT  sinv|/ccMT 
f vcCCMX 


3 


cos0XM  sin\|/TM  + — — cos0T  sin\)/T 
VM  VM 


(A2.14) 
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sin0ccMX  = 


VCCCMt  .n  VT  •  n 
- — - sinuXM  +  — — sinbx 


(A2.15) 


Equation  (A2.15)  gives  us: 


0ccMX  =  sin  1 


fvcCCMT  .  0  VT  .  n 

— — - sin  t)XM  +— — sm«x 


M 


M 


(A2.16) 


Similarly  equations  (A2.13),  (A2.14)  (after  some  straight  forward  algebraic  manipulation  give 
us: 


(YvC 


Y|/ccmx  =  tan" 


CCMt 


3 


cos  0 Xivi  sinv/TM  _l - cos0x  sinv)/x 

VM  VM 


—  cos  0 T]vi  sin  Vj/XM  "* - cos0x  sin\j/x 

VM  VM 


(A2.17) 


C.2  Computing  2-DOF  Collision  Course  Missile  Heading  Angles: 

C.2.1  Vertical  Plane  (XxZ- plane)  Engagement: 

For  this  case  (yx  =  yMcc  =  ys  =  o)  and  (px  =  (0X  -  0S  )),  (pMcc  =  (0Mcc  -  0S  ));  hence 
utilising  equation  (A2.5)  we  get: 


(0Mcc  -0S)=sin  M— Lsin(0x -0S) 

l  VM  J 


(A2.18) 


0Mcc=0s+sin  M^sin(0x-0S)} 


(A2.19) 


C.2. 2  Horizontal  Plane  (XxY-  plane)  Engagement: 

For  this  case  (@x  =  0Mcc  =  6S  =  °)  and  (px  =  (v|/x  -  ys  )),  (pMcc  =  (vmcc  -  Vs  ));  hence 
utilising,  as  previously,  equation  (5)  we  get: 


VMcc=Vs+sin 


(A2.20) 


M 
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